// 创建socket描述符
   // 启动windows socket start
   WSADATA wsaData;
   if (WSAStartup(MAKEWORD(2, 2), &wsaData) != 0)
   {
       printf("PC Server Socket Start Up Error \n");
       return -1;
   }
   // 启动windows socket end

   int serverSockfd;

   serverSockfd = createTcpSocket();
   if (serverSockfd < 0)
   {
       WSACleanup();
       printf("failed to create tcp socket\n");
       return -1;
   }

// 绑定端口
   if (bindSocketAddr(serverSockfd, "0.0.0.0", SERVER_PORT) < 0)
   {
       printf("failed to bind addr\n");
       return -1;
   }

// 监听
   if (listen(serverSockfd, 10) < 0)
   {
       printf("failed to listen\n");
       return -1;
   }
   
   printf("%s rtsp://127.0.0.1:%d\n", __FILE__, SERVER_PORT);

// 监听连接客户端的循环
   while (true) {
       int clientSockfd;
       char clientIp[40];
       int clientPort;

       clientSockfd = acceptClient(serverSockfd, clientIp, &clientPort);
       if (clientSockfd < 0)
       {
           printf("failed to accept client\n");
           return -1;
       }

       printf("accept client;client ip:%s,client port:%d\n", clientIp, clientPort);

	// 处理接受到数据后的逻辑
       doClient(clientSockfd, clientIp, clientPort);
   }

while (true) {
    int recvLen;

    recvLen = recv(clientSockfd, rBuf, 2000, 0);
    if (recvLen <= 0) {
        break;
    }

    rBuf[recvLen] = '\0';
    std::string recvStr = rBuf;
    printf(">>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>\n");
    printf("%s rBuf = %s \n",__FUNCTION__,rBuf);

    const char* sep = "\n";
    char* line = strtok(rBuf, sep);
    while (line) {
     
        if (strstr(line, "OPTIONS") ||
            strstr(line, "DESCRIBE") ||
            strstr(line, "SETUP") ||
            strstr(line, "PLAY")) {

            if (sscanf(line, "%s %s %s\r\n", method, url, version) != 3) {
                // error
            }
        }
        else if (strstr(line, "CSeq")) {
            if (sscanf(line, "CSeq: %d\r\n", &CSeq) != 1) {
                // error
            }
        }
        else if (!strncmp(line, "Transport:", strlen("Transport:"))) {
            // Transport: RTP/AVP/UDP;unicast;client_port=13358-13359
            // Transport: RTP/AVP;unicast;client_port=13358-13359

            if (sscanf(line, "Transport: RTP/AVP/UDP;unicast;client_port=%d-%d\r\n",
                &clientRtpPort, &clientRtcpPort) != 2) {
                // error
                printf("parse Transport error \n");
            }
        }
        line = strtok(NULL, sep);
    }

//开始播放，发送RTP包
if (!strcmp(method, "PLAY")) {

    int frameSize, startCode;
    char* frame = (char*)malloc(500000);
    struct RtpPacket* rtpPacket = (struct RtpPacket*)malloc(500000);
    FILE* fp = fopen(H264_FILE_NAME, "rb");
    if (!fp) {
        printf("读取 %s 失败\n", H264_FILE_NAME);
        break;
    }
    rtpHeaderInit(rtpPacket, 0, 0, 0, RTP_VESION, RTP_PAYLOAD_TYPE_H264, 0,
        0, 0, 0x88923423);
    // 0x88923423 SSRC 已写死

    printf("start play\n");
    printf("client ip:%s\n", clientIP);
    printf("client port:%d\n", clientRtpPort);

    while (true) {
        frameSize = getFrameFromH264File(fp, frame, 500000);
        if (frameSize < 0)
        {
            printf("读取%s结束,frameSize=%d \n", H264_FILE_NAME, frameSize);
            break;
        }

        // 判断当前帧起始码
        if (startCode3(frame))
            startCode = 3;
        else
            startCode = 4;

        // 帧的实际数据长度
        frameSize -= startCode;
        rtpSendH264Frame(serverRtpSockfd, clientIP, clientRtpPort,
            rtpPacket, frame + startCode, frameSize);

       

        Sleep(40);
        //usleep(40000);//1000/25 * 1000
    }
    free(frame);
    free(rtpPacket);

    break;
}

memset(method,0,sizeof(method)/sizeof(char));
memset(url,0,sizeof(url)/sizeof(char));
CSeq = 0;

static int getFrameFromH264File(FILE* fp, char* frame, int size) {
    int rSize, frameSize;
    char* nextStartCode;

    if (fp < 0)
        return -1;

    rSize = fread(frame, 1, size, fp);

    if (!startCode3(frame) && !startCode4(frame))
        return -1;

    nextStartCode = findNextStartCode(frame + 3, rSize - 3);
    if (!nextStartCode)
    {
        //lseek(fd, 0, SEEK_SET);
        //frameSize = rSize;
        return -1;
    }
    else
    {
        frameSize = (nextStartCode - frame);
        fseek(fp, frameSize - rSize, SEEK_CUR);

    }

    return frameSize;
}

static int rtpSendH264Frame(int serverRtpSockfd, const char* ip, int16_t port,
    struct RtpPacket* rtpPacket, char* frame, uint32_t frameSize)
{
 
    uint8_t naluType; // nalu第一个字节
    int sendBytes = 0;
    int ret;

    naluType = frame[0];
    // 获取后五位 naluType = frame[0] & 0x1F;

    printf("frameSize=%d \n", frameSize);

    if (frameSize <= RTP_MAX_PKT_SIZE) // nalu长度小于最大包长：单一NALU单元模式
    {

         //*   0 1 2 3 4 5 6 7 8 9
         //*  +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
         //*  |F|NRI|  Type   | a single NAL unit ... |
         //*  +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+

        memcpy(rtpPacket->payload, frame, frameSize);
        ret = rtpSendPacketOverUdp(serverRtpSockfd, ip, port, rtpPacket, frameSize);
        if(ret < 0)
            return -1;

        // 加序并累计
        rtpPacket->rtpHeader.seq++;
        sendBytes += ret;
        if ((naluType & 0x1F) == 7 || (naluType & 0x1F) == 8) // 如果是SPS、PPS就不需要加时间戳
            goto out;
    }
    else // nalu长度小于最大包场：分片模式
    {

         //*  0                   1                   2
         //*  0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3
         //* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
         //* | FU indicator  |   FU header   |   FU payload   ...  |
         //* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+



         //*     FU Indicator
         //*    0 1 2 3 4 5 6 7
         //*   +-+-+-+-+-+-+-+-+
         //*   |F|NRI|  Type   |
         //*   +---------------+



         //*      FU Header
         //*    0 1 2 3 4 5 6 7
         //*   +-+-+-+-+-+-+-+-+
         //*   |S|E|R|  Type   |
         //*   +---------------+


        int pktNum = frameSize / RTP_MAX_PKT_SIZE;       // 有几个完整的包
        int remainPktSize = frameSize % RTP_MAX_PKT_SIZE; // 剩余不完整包的大小
        int i, pos = 1;

        // 发送完整的包
        for (i = 0; i < pktNum; i++)
        {
            // 2、3位与运算 后五位28或运算
            rtpPacket->payload[0] = (naluType & 0x60) | 28;
            rtpPacket->payload[1] = naluType & 0x1F;

            if (i == 0) //第一包数据
                rtpPacket->payload[1] |= 0x80; // start
            else if (remainPktSize == 0 && i == pktNum - 1) //最后一包数据
                rtpPacket->payload[1] |= 0x40; // end

            memcpy(rtpPacket->payload+2, frame+pos, RTP_MAX_PKT_SIZE);
            ret = rtpSendPacketOverUdp(serverRtpSockfd, ip, port, rtpPacket, RTP_MAX_PKT_SIZE+2);
            if(ret < 0)
                return -1;

            rtpPacket->rtpHeader.seq++;
            sendBytes += ret;
            pos += RTP_MAX_PKT_SIZE;
        }

        // 发送剩余的数据
        if (remainPktSize > 0)
        {
            rtpPacket->payload[0] = (naluType & 0x60) | 28;
            rtpPacket->payload[1] = naluType & 0x1F;
            rtpPacket->payload[1] |= 0x40; //end

            memcpy(rtpPacket->payload+2, frame+pos, remainPktSize+2);
            ret = rtpSendPacketOverUdp(serverRtpSockfd, ip, port, rtpPacket, remainPktSize+2);
            if(ret < 0)
                return -1;

            rtpPacket->rtpHeader.seq++;
            sendBytes += ret;
        }
    }
    // 时间戳累计 fps=25 时间定义1s=90000
    rtpPacket->rtpHeader.timestamp += 90000 / 25;
    out:

    return sendBytes;

}